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(54) AUTOMATIC TRAVEL VEHICLE 

(57)Abstract: 

PURPOSE: To judge travel possibility degree by conducting fuzzy theory 
based on respective detection values of obstacle conditions and own 
vehicle conditions, recognize travel environment including other vehicles by 
selecting one of the plural travel possible regions based on the results, and 
enable automatic travel while changing a traffic lane arbitrarily. 
CONSTITUTION: An automatic travel vehicle is provided with a CCD 
camera 10, a radar unit 12 consisting of a millimeter wave radar, a yaw rate 
sensor 14, a speed sensor 16. a steering angle sensor 18, etc., a plurality of 
travel possible regions are recognized in the vehicle approach direction by a 
controller based on these detection signals, and the conditions of an 
obstacle including at least location of the obstacle existing around the 
vehicle is detected. Fuzzy theory is conducted based on detection value of 
the own vehicle so as to judge travel possibility degree, either of a plurality 
of travel possible region is selected based on the judgement result, and 
control quantity of vehicle travel is calculated based on own vehicle 
conditions and calculated travel locus so as to make it travel in the 
selected travel possible region. 
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[0007] 

[Means for solving problems] In order to solve the above described 
purpose, the present invention comprises recognition means for 
recognizing a plurality of drivable ranges vis-a-vis a driving direction 
of a vehicle, obstacle condition detection means for detecting a state 
of an obstacle existing in the surround of the vehicle including at 
least a position of the obstacle, vehicle-itself state detection means 
for detecting a state of the vehicle itself at least including a vehicle 
speed, and a position and a bearing, thereof vis-a-vis the plurality 
of drivable ranges, drivable degree judgment means for judging a degree 
of drivability relating to the plurality of drivable ranges by 
conducting a fuzzy theory based on a detected value, selection means 
for selecting either one of the plurality of drivable ranges based on 
the judged degree of drivability, track calculation means for acquiring 
a driving track of the vehicle itself based on at least the detected 
state of the vehicle itself, and control quantity calculation means 
for calculating a control quantity of driving vehicle based on at least 
the detected state of the vehicle itself and acquired driving track 
so as to drive in the selected drivable range for a vehicle which 
automatically drives while recognizing the outside world as put forth 
in claim 1 for instance. 
[0008] 

[Operation] This enables a stable automatic drive while selecting the 
most optimum drivable range in a road environment having a plurality 
of drivable ranges in which obstacles including other vehicles exist. 
Note that the drivable range means a lane herein. 

[0009] 

[Embodiments] The following describes the preferred embodiment of 

the present invention by referring to the accompanying drawings. 
[0010] Fig. 1 is a perspective diagram showing the entirety of an 

automatic drive vehicle according to the present invention. Referring 
to the drawing, the automatic drive vehicle comprises one CCD camera 
10. The CCD camera 10 is fixed onto a rearview mirror mounting position 
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above the driver seat and views a driving direction of the vehicle with 
a single eye. A component sign 12 shows a radar unit comprising a 
millimeter wave radar, which is constituted by a group of ten radars, 
i.e., two front radars 12a mounted on the vehicle front, three side 
radars 12b mounted on the vehicle sides and two rear radars (not shown 
herein) mounted on the vehicle rear, detect the existence of 
three-dimensional obstacles such as other vehicles by means of 
reflectance waves. A yaw rate sensor 14 is installed in the approximate 
center of the vehicle cabin for detecting an angular acceleration of 
the vehicle around the vertical axis (i.e., z axis) thereof. In addition, 
a vehicle speed sensor 16 comprising a reed switch is installed in the 
neighborhood of a vehicle drive shaft (not shown herein) for detecting 
a drive speed of the vehicle and also a steering angle sensor 18 is 
installed in the neighborhood of a steering shaft 20 of the vehicle 
for detecting a steering angle. 

[0011] A steering angle control motor 22 is also mounted onto the 

steering shaft 20, a throttle actuator 24 comprising a pulse motor is 
mounted onto a throttle valve (not shown herein) , and brake pressure 
actuators 2 6 (not shown in Fig. 1) are mounted onto brakes (not shown 
herein) . In this configuration, the vehicle is controlled for a 
steering angle according to a calculated steering angle quantity, is 
also adjusted for a vehicle speed as a result of the throttle valve 
being opened or closed and is enabled to automatically drive by the 
brakes being operated as appropriate. 

[0012] Fig. 2 is a block diagram showing the above described 

configuration in greater details. An output of the CCD camera 10 is 
sent to image processing hardware 30 for being subjected to necessary 
processing therein and the processing result is stored by shared memory 
34 by way of a bus 32 . An image processing CPU 3 6 and an image evaluation 
CPU 38 detect a condition of a drive road by reading out a stored value 
at every predetermined clock time. An output of the radar unit 12 is 
stored by the shared memory 34 by way of a radar processing circuit 
40 and the bus 32. A radar evaluation CPU 42 detects a position of an 
obstacle on a coordinates by reading^ out a stored value* at every 
predetermined clock time. 



[0013] Meanwhile, outputs of the vehicle sensor 16, et cetera, are 

sent to a track estimation CPU 44 for estimating a movement track of 
the vehicle itself. An action plan mind decision CPU 50 generates a 
target path from the aforementioned stored value. The target path and 
the estimated movement track of the vehicle itself are sent to a track 
follow CPU 46 for determining a track (target path) follow control 
quantity therein. The track follow CPU 46 further calculates a steering 
angle control quantity and outputs it to a steering angle control CPU 
52. The steering angle control CPU 52 drives the steering angle control 
motor 22 by way of a PWM controller 54 and a driver 56.' Note that a 
motor drive quantity is detected through an encoder 58 for carrying 
out a feedback control. 

[0014] The action plan mind decision CPU 50 also has its 

speed/follow control unit acquire a target acceleration of the vehicle 
as described later and send it to a vehicle speed control CPU 60. The 
vehicle speed control CPU 60 drives the throttle actuator 24 by way 
of. an acceleration pulse motor controller 62 and a driver 64, and also 
drives the brake pressure actuators 26 by way of a brake solenoid 
controller 66 and a driver 68. The drive quantity is detected by way 
of a pressure sensor 70 for carrying out a second feedback control. 
Note here that sensor processing circuit such as a waveform modification 
circuit is omitted for simplifying a drawing in the above description. 
Fig. 3 is a functional description of the block diagram shown by Fig. 
2. 

[0027] Fig. 12 shows a fuzzy expert system according to the present 

embodiment in which a fuzzy reasoning consists of a primary reasoning 
and a secondary reasoning. In the primary reasoning, a degree of 
drivability for each lane is estimated from a characteristic quantity 
of a road by using a lane drivability degree rule and also a degree 
of an obstacle driving possibility from a characteristic quantity of 
an obstacle by using two kinds of obstacle risk judgment rules. 

[0028] In the secondary reasoning, a degree of drivability for each 

lane is integrally estimated, by using a drivability judgment rule, 
from the degree of drivability estimated by using the lane drivability 



degree rule and from the degree of drivability acquired by using the 
two kinds of obstacle risk judgment rules (which are collectively called 
an obstacle risk degree rule) . 

[0029] Note that, since a characteristic quantity (i.e., a 

reasoning parameter) per se is not different among the lanes, each lane 
is estimated by using the same group of rules. Also note that thus 
reasoned values are apparently different among the lanes because the 
reasoning parameters are different among the lanes. 

[0056] Figs. 30 through 33 show an actual vehicle driving test with 

regard to the above description. Fig. 30 shows the case of driving by 
following a preceding vehicle that drives at a constant speed, 
apparently showing a situation in which the vehicle precisely follows 
the preceding vehicle at a predetermined distance therefrom. Fig. 31 
shows a degree of drivability in this event by using a multiple reasoning 
proposed by the present invention as compared to the case of reasoning 
by the conventional method. As shown in the drawing, there has been 
little difference between the two results. 

[0057] Fig. 32 is the same test data chart as Fig. 30, showing the 

case of stopping by following- the preceding vehicle. And Fig. 33 shows 
a degree of drivability reasoning in this event with regard to an 
obstacle discovery point as a comparison between the conventional method 
and the multiple reasoning proposed by the present invention. As in 
the case of Fig. 31, this test result also shows little difference 
between the two methods . 

[0058] The present embodiment is configured to use a concept of 

a degree of drivability for a lane and judge it by using a fuzzy reasoning 
as described above, and therefore it is possible to drive stably by 
constantly selecting the most optimum lane even in a road environment 
with a plurality of parallel lanes and obstacles being interspersed 
therein. It is also configured to select a lane by reasoning a degree 
of drivability for each lane from a presence or absence of an obstacle 
and therefore there is no risk of contacting with an obstacle, et cetera. 
[0059] It is further configured to judge a degree of drivability 

for each lane by using a fuzzy reasoning, thereby enabling a driving 



control matching a feeling of a person skilled in the art, and also 
configured to use a multiple reasoning for the fuzzy reasoning, thereby 
enabling a reduction of a calculation amount and a memory volume, and 
an improvement of debug efficiency. 

[0060] It is further configured to judge a degree of drivability 

for each lane by using a fuzzy reasoning and also determine a target 
lane from the reasoning by the comparison with a threshold value, thereby 
making it possible to adjust a frequency of lane changes by increasing 
or decreasing the threshold value and drive more optimally responding 
to a road environment. 

[0061] Note that, although the above description uses a two-stage 

connection of the multiple reasoning for the fuzzy reasoning, a 
three-stage connection or more can be used as long as the reasoning 
parameters do not interfere with one another. 

[0062] Further note that the fuzzy reasoning parameters may use 

various kinds such as a curvature of a lane, a speed of an obstacle, 
a speed of the vehicle itself, a target speed of a vehicle, in addition 
to the ones shown by the present embodiment. Note also that, although 
obstacles only existing ahead of the vehicle itself are used for the 
fuzzy reasoning parameters according to the present embodiment, the 
ones existing behind the aforementioned vehicle may be used therefor. 
[0063] Yet further note that, although the visual sensor is 

configured for a single eye view, a both-eye view may be used for 
eliminating a front radar, et cetera. 



5 



(.ma*mmf? up) <i2) & »f$ §^ ^ ^5 (a) oDttfttfwfin** 

#H¥7-81604 



(43)&BBB ¥fifc7*p(1995)3fl28B 



(SDIntCL* 






F I 




B 6 2 D 6/00 




9034-3D 






G 0 5 D 1/02 


K 


9323-3H 






G0 6T 1/00 










G0 8G 1/00 


J 


7531 -3H 










9287 - 5L 


GO 6F 


15/ 62 3 8 0 








ifcjff* ^JS(D*5 FD (3* 21 JO St»M\zm< 


<2l)flfflBW 


!ftK¥5 -254896 




(71) USA 


000005326 












(22) {MSB 


5p^5^(1993)9^17B 












(72)#^# 


Hffi 




























(74m8!A 




(54) 











(57) immi 



I «Mwna»A?j 

— x — 



-] 



i 



j WoWWttK J sia wje^t. van. (iwO 

_L 



S26 «tKH ftrit 



C [ 



532 



c 



S3* Rm, RuM 



(2) 



&I§SJ¥ 7-81604 



[*itat*a>«sB] 

[ig*a 1 ] L-o-ommmfr? zmmza 

a. «iijtfi-*is]i=»LTig»©jtffpi^fi«*ssa-r 

[ss*«2] h. < .ttaiflE^tb^+tfcKgferott 
^Slcs-^u^Tf§s#l(De^ij|»l^|i^*«)^^i(ltllaimt^J# 

[8»*«3] sjfE*uwamta#sii. hies« s*if= 
fcsiEr a c t znmt -r £§t*ii 1 «*r= 

l*2]SfE*£<&(i!S36*T*iil3. 

tss*^4] sifE*i»a^tti*sii, ifrtES«*+ifc 
^ff Bimmm izn-r s m^s-mas £ * *> * #a $ it 
x i> c t & nmt ? 1 m u i> l 3 mo i^-m ^ 

c. BtIfE«llll$+tfc/'«7>—S'^f}#ffl5lrfflLNr7Ti; 

d. fJfESH*^£tfJ#fi|il=JBl*Tfgn (n^2) ©77 

ntb-f £*«§t? thrifts $(«xfcci:^#^«t-ri)g 



[000 1] 

izM-t*. 
[0 0 0 2] 

m*<D&m mmitiTt&mzmLTit9Liii&vm*o> 
tnitmmzixT&v. 2 6 3 1 o 

fc*tU8SAt5fel=#Ba¥3- 1 5 8 9 7 6#^«-Cg») 
[0 0 0 3] 

[*MA<«*L<fe5i:-r€.Sa] COflUc^Sjjtmitfi 

iz-o^xft^x'^utamtmrntixxi^i!)^ 
rows $%-r*iiKi=t5urttmi=*«a:M 

[0 0 0 4] «toT. C0>f§BJ0>SWli±fiE©&IS£fl? 

[0005] w.&o>m&£m-?z>tmz^ mm 
z&t;mwmm&-tzjk&mmzte^xmmum®$: 

[0 0 0 6] MICI±, 7 7^w-Jtffi*fflLx§i:*(c % 
[0007] 

[iSS£fl?3*-f &fc#><7>#fS:] ±IEW@W^fi?*-r-5fc 

to(c**B^i*ei|xi«B*iii«(c*-rsn<. ^^sia 

esai-r^KS^^tii^-s. m3§fc«feu:fifEi®sjro^ 
pifiiMniti=»-r*sm(7>ias<t7Ji2«t i&u < ,t 



(3) 



^¥7-8 16 04 



•3iNT 77^ «tst£fTo xmm&o) fen ssmm&iz 

[0 0 0 8] 
[0 0 0 9] 

MM] ttT. Bf*BB(=»LT^<D«Wa>l*li«* 
[0 0 10] Bl(*c0>«Bfcff«ett£ff*B*£1* 

CD^l/^IOSllf^^o CC D^3>7 1 0 (*jMIe 

a>fc*u— y (Bswr) ami o«(Di/- ?Bfr&tt 

#»f&*u *fl<DIBBtt (zM) ByoMlKttt 

tn-r^o sic. »^F7>f^7h (B*i*-r) <z> 

fl-iBCciiU— KX-f >1M 6A<iftlt 

[0 0 1 1] *fc % 8Xf7'J^vt7 h2 0lcf*$t 
ft*jffll^E-^ 2 2j5<*ytt(f 6*l*£#(c. XP^hJU 
# (B«1*"**) l=f*/^UX^— ***6ft4XP* HUT 
**a.x— *2 4#*yffrlt&*u Mlc;/u-* (B*f 
■B-f) IC|*^U— *tt*7£^:i.X — * 2 6 (01 "CB 
^88) 3ft<*yftlt6*u*. C0)fl|jC(=fil\T. *ffil* 

[00 12] B2(*±|B(D*rt*«fey»Blc5c-<-^p^ 
tmX&ho CCD*/7 1 O0tti*f*ll««l3t/\— K 

0x73 oicai^ttTifcs^toa^ff^+t. *(7>$smi* 

AX3 2*frLT#**^U 3 4ICX K7S*t*o BIB 
MCPU3 6*5*t;B«fMiCP U 3 8 I^F/r^B#glJ cT 

tizx hr«*K^aiLr36ffttBa)«B*tttB-r«„ 



/<X3 2*^LT**^^U 3 4(=X hT**l4o 
^PfflC P U 4 2 l*RJr£B#£lJ§[CX hTflt^lS^di LT 

[0 0 13] 6&ifOU*I*«l»ft3e 
c p u 4 4 «*BO)*IMUIitfBC«*i«. 

ff Bwnweajg c p u 5 o i*«riBx h * s sag 

ttli«i*i6«£cpu4 6(ca|t>*i. * = T?*U* (B«B 

ft) iMHMtt**<ft£$*t<&. »=. «iimm£«micp 

U4 6I1 {Rft *ISPS£ If fcU L T ttfl MB CPU52I: 

fcU:fc-f£o ffift*J^CPU52|JPWM3>hQ-75 
4*5*tf K^-T/<5 6t^LrfHEt6ftMB*-* 2 2 

[0014] *fcfrMttB*S»5£ CPU50 l**<Di$ 

*iS«IIHlCPU6 0(caiU-r*o »iI*l|$PCPU6 0(* 
T^HzJU/^UX^E— KP— ^6 2. K5-f/<6 4 
^LtXP^ h;i/7^fai-^ 2 4*iBia-r^i:^ 
lc. ^U— tVI/^-f K3>hP — 5 6 K^-T 
/<6 8SfrLt?b-+E*75fai-* 2 6£SBIS 
t^o *a>BM*i*lE*-fe:/-fr7 0$:TM.T8Sfcb£*i. 
«2(D^-r— K/<->^*i»A<ff3bti*o ft. -tlE(cfci\ 
T. B^OfffiBSlbOtctf). a»B»HBa^-fe>-9-0>ja 
SB»l**l*fc. B 3 (*B 2 ztu v * B**M6MlciM- 

[0 0 15] ftivc. 047P- - h£#B&LT 

-hi*. «HBLfcfrBttB«»»3ecPU 5 03&<ff5» 

[0 0 16] 5feT. S 1 OC&^tMIWttliAA 
« e c*L(4|l||HL/=B*ft«CPU3 6fc«fctfBfltB 
ICPU3 8 0)dj;fD£A:*l LT*t5o BP*>. BftflkBC 
PU3 6l*B5lc^«|«AABift^&SBB»B (* 

•C»¥BMt*A, *«ja»*B¥B-ta)jS5«-r— * 
fcL-CBWWBBttrtDLrill*-*-*. BftlfffCP 
U3 8i*. **ii=*^ra-eifi-<««(cJW8«ttifa) 
B««j:f-*Slli*t4 0 S 1 Olc&iNTIictib* A 

[0 0 17] Hfcl^cS 1 2lCJt^-CfU— yBffiJSaSA 

*t4o ctLliflfBLfcL/— ygpfiffic P u 4 2 0>a** 
A^-T4-i:-Cfi : '5o S 1 Ofc£tfS 1 2^^^^<b(c 

J: y ffiS8tH®s*s g p u 5 o i*b 6 iZ7jk-?mteft& 

[0018] i&i^xs 1 4izmAjvmmm&m 
mm) t&mt<D&mMfc$:#itb&o miStmmcpu3 

BB4*Lfc*««»«3W'j7;u*-f Aicaa* 



(4) 



t* mW- 7 - 8 1 6 O 4 



*f*LTl#3tL. **atf!#HfS (ftL^L*«) 

fcBJUK (IitfA9 3-1 02 5) (C^<Tfc£0) 

[0 0 19] ffii^xs 1 eiz&A,v*Mhm9fatO)VL 

[0020] mi^xs 1 8(cit^T?*«a>m«*attj 
u s2oicsA/ fl c*«n<oi««ttflr«i«»ur«. - 

[002 1] cfcyjlttWlCtt. *||a>nf«Rt*A2ltt0>3R 

0-1 
0-5 

#BSBa*-e<0iE» o-i 
fflttifig -ioo 



-10 0* 

[0 0 2 3] »itX. 77i?^*&(D^>/H > 

0 1 Ofcl*Lia 1 1 icKSLfc^r^-f 9*^*5* 

<*) . PS (*L*#W . PM . 
PB , NB (#ttl=/Jx*lx) . NM 

. N (/Jx*ix) . Z (UttX) , P 

*ytti**Htfc. 

[0 0 2 4] fltt^rS 24|:1^77V<I+X/<- 

-5c 

[0 0 2 5] *ftlcoivcHW*-*±:* itSft. BSfcfc 

«*<d« * fcttsecijc i: rMicfl k l t *t is * t* * i= 
mm?&<D4>&tbxmnx&& 0 zomtzmnxmrnfr 

If Si £ ffl I* 4 7 7 v *f x + x / <— h > x f- A t 
%*.b*l£o 7 7 y ^ x^pX/^- h vXfAt fehll 
*A*. ¥ffHtt*»*<RTtt-C?*y. 

AIB0>7-f — U >^lc7^ft4« 



ttLT£*H£<DBB«*3Rtf>. S«W(r|a^(DJD<. ft 

±zfmmmmtm&to&&k<Dm&&nt#>xft»&k-? 
[0022] *si*rs 2 2izmAjx±tm&m (jtsft/\° 

*> S77vVl^fttl)o 77y-fl»Tfl) 

Ltz a 

0 0m 0—1 
m 0—1 
0 0m 0—1 

— 10 0 km/h - 1 — 1 

1 O 0 km/h - 1 - 1 

|*77v>fX^/^- hyXfASlL^^iCLfc. 
[00 26] <tC^)-C % 7ry^i4X/^-hyXfA 
*flH*«£LT*i. A**fM><£l*fctf>* /I/— ;U«3b<« 

[0027] h 1 2(c*it«-c?a>7T^-r x+x/<— h 
yXfA^t, HS6G*IT*f*. 77vVlSiS-*}t» 

[0 0 2 8] -^mmXit. *«j6fTRltB**LVl.— ;U 

(iliftRfipLvi/-^ <t 4 ) t 
[0029] - >) 

[0030] B1 3S^LB1 6(C. C^i=>(7>3ig(D~ 



(5) 



-8 16 0 4 



[003 1] cc-c**^cz>*igs^;£ OUT r^sfg 
SNtffl* Lr«ffl-r-6«irLfco £yjy*tfnci*i2i 3 

£I*LB1 6*5«fctf(2l 8IC^-T$0<. -^JtStJU— ;U 

[0032] w*>. mso? -r v << femazm 1 9ic^-r 

All. 1 2<7» ^^^fi<D3*>g^fi$S«L 
t»M77V-f 7^B 1 (D^U— Kfloi 1 

>r^^B2<D^U-Kffia>2£3R#u Sili±tPSt 

1, R20)^SItb^<t^-^o *<DS!S^ B1 2|C^-f4§ 

B2 0(=E«Tr*«(c^-;U*36<»*i:«:*. 
[0 0 3 3] f:t\ Mfcftlirfci^TfiB i 3 <*r<^lc^ 

(cLfco ip*>. mi 3 aims. 77vo^atz 

O, PS. PM. PB(D4l^fflLtU^ 

I*. PM*CW*l£ 3ffl0)fI£}$O o f LtPM(D3ia) 

[0034] zee. PM<D3^0>fi&a>;*;/jx|i§te£j|£ 
^(^^-eS^cotcTXi. f(D77vo'<^ (BP 
pm) tit^- JWffi&mtfmwx+fo&frh. 
7 is- Kit <t o t cd r ^ a> ? 7 ^ £ 

[0 0 3 5] yi/- Kil477»-f fcHlCiSl^TB** 
*>4«|::Lfco 12 1 6CD*M(c. C(7)«{- Lt^^z 



[0 0 3 6] fiaiML I2 2 0(c^-r«ir % ;u-;u»£ 

[003 7] B 2 1 li±E Lfc 7 7 h •> 

TH*a>tt<*3e**L*. B^ttli. 

^r=tt3fla>»«36<sftr-&5l»ffl«a>a#-ea&-So u 

[00 3 8] *J6«i=fcL^rf*. z^filicSM 
ffl5-r*c£jb<-e#fco 12 1 2lcac-r«i= % &ivcc*uc 

[0039] miyn— - T-v—^izm&t. mi^xs 

[0 0 4 0] B2 2f4*0)aiR^jR*^f • ^-V 

— h-efe^o iqB0>KH(cA«ffllcB2 3$#ilTC 

[0041] ■'2 2*MLT±B*nwrr«&. *r 
si 0 0T?e**8a>36ffRrtt**t^<xu^*>i^K 
waT*5**«rU S5££*is<t£i4s 1 0 2icitw, 

T?S*««H»U Sl04CS^I«*M«Mlt 

S 1 0 6lCj|t*K **«0)j6fTRrSBa*L^<Xly^*>a. 
[0042] S 1 0 6Tf»ffi**L*t#<*S 1 0 8 (Cit 

pTfi6ffi^L^a>^*</h* < ttL^-e. s i 1 oizm/uvm 
mmm$:&mt&kL. s 1 04^CJi^r*gsm^a^sm 



(6) 



16 0 4 



[0043] s 1 o 8v&mmt<r>jk?f»itfe&£ 
wmt)<WLj£m±*>)'m^tmmz*i&t£its 1 1 z 

lcit^■e^E*^S(Djt^TPIfilJa^t^*<^u^i>i^-;^ Ktt 
ia±*>s^*iJBf-r*o ml s 1 oex&jzztiztziz 

S 1 1 V^f^o 

[0 0 4 4] si 1 ar^m^^^pT^B-L^xu 

i^SM*r€>mi**<^t><D-e. s 1 o 2icjtA>T*e«js$ 
«H*-r«t*ic % s 1 1 2-e»5e**i*£*r*s 1 1 4 

lis 1 1 6lc£A-t?&*tt*g**iR£:-r«. H % « 

ltd ctA<IHMi:ftor^*^6-e**. 
[0045] B47P- • hlcp&<t % |gl*TS 

[oo4 6] mziz&mLxmwr&t. b«*is*< 

M. -0>SI*«Cz*5l^r*«<DXlil**Poaifr*B»ci: 

-So 

[0 0 4 7] @«*«A<ffe*«a>»*. *<7>mf£ 

->^x>v. 7txV>h) (a) *3M?U *<»&W- 

(a) *&«*ttB*-C0Mt# (b) *<7>*8# 
lC*tU 2. 5m^Cx, y<0jS*»5rr*o ML C 

ctmm (a) i±. &mmvizm&&m. (u->^x> 
v) *3e»iHT*»i:/=Ei«LTf**>«o ml u->^ 

[0 0 4 8] miZ % fig (a) <D^iSlcBS1*lA<#«-r 

(b) s^ArHwicfta-j-ft. 

[0 0 4 9] *^7?S 3 0lC«Ar-e«i»Jt3t>S**A* 
■T^o 5fe(c0 2|cB8Lra^<fc«lc, h-tr>-* 
1 4^^dl^^bifiai}tScpu4 4i:^^tg¥a) 

[0 0 5 0] ISLETS 3 2(C^T?B««K<Dil*Ll»M 
[00 5 1 ] HP*>. S2 8-eg*«ift3b<ttH$tL. **L 



S*l*W&AMc-t(DB|l=»ttLTL^*. 8ot, 02 6 
[0052] «l^tS3 4i:1^7r^3> ha — 

[0053] Bi 2 7{«*i*^-r^n^^H-efcy. IB 
2 8fi^(D*o>j!iniSJS*I»SS<D»jai$^^p **Ht? 
fc*o 0 2 9(iB^to8JS<D«Stfcteffl£;ft£>:7 

rv-r ■ v^^Ba»*^-r 0 H2 7ie*ji*T7 

m<Dtt*4mmt$±if&mi£m£Aj3'^*-< &t lx? 

T»-r«HtfTt\ B«UnSflE«lKtb-r«. ML AoiS& 

[0 0 5 4] IB 2 8(Zi$|ffl$^-r*Di$jt*|^lS&|Cfcl^r, 

h;uBB*ft^L^u— *ffi**B«flti=P i d»] 
«rr*o ^««Jtt(cj:y % «T*£(DK»*»Me(D«i:: 

«%ooB**pjB«-ca»«ff-r«ci:A<-c*. mma> 

9h£iz&CXliammt4:l*L&±t&zki><X&Z>o 
[0 0 5 5] fifties 3 6T?H2<Dtt»i&tt*|f»CPU 
4 6. ttft*|^CPU5 2, (ftD&ltfflft) C 

[0 0 5 6] 0 3 0^>L(2 3 3|C±fEf::oi^T<&gim 

jtft^x h*S££^f 0 0 3 0l*j6»fifW*W**(:: 
j£*lciEfillciiftLri>^«TA<MT^tVcfc5o IB3 1 

ic. *a>t#a>j6ffRr«flE*L^tt*#3»(c € ky}iiiL 

[005 7] H3 2%H3 0£H«0>^X h-r^B"*? 
SfTjt*lCl6i:Tf?JhLfc»**^-rc *fc. 03 3IC 

«siLfc*a^*«itLr^-ro 03 1 ±n«ic. za>^ 
x ht&mxtffimiziztAjfmmtftefr^tz. 

[0058] z<Dmmmi*±izcoto<mffi<»7Ei=r-zjm& 



(7) 



*$f*)¥7 -8 16 0 4 



[oo6o] jEi-. ?7i><<mm£m£xm»z:ko>m 

[006 1] ML ±1EI=*51*T* ^TV-f ft»00*M*6 

IMBU. 3aS^LI4t*i)Sl±t»«Lrta^o 
[0062] »c % ^rv^lli/O^-^^ttlll 

[0 0 6 3] »c. »fe:/**JMB«±Lfc*<. iHaflB 

[0 0 6 4] 

[^(oai] »#aiac*oti*, 

[0 0 6 5] R#3S2«(cfeoTli. «HELfc»»lc*P 
[0 0 6 6] IS*^3a(cfcoT(i. *g»ca»ia*<¥fr 
5 § ««!.»(:: o TIEfitic jtftf 4 c t tfX £ 4 „ 

[0 0 6 7] »#«4«(CfcoTH\ «»<D*«A<¥fT 

[0068] is*Ji5 3gicfcoTii. ?7&<fmm&m 

[Hi] ca>«M(z««SiiijfefT*ias*±(*«ic^-ritt 
[02] B1 i=»r-b>**5<fctf*a>»aiftiftBiBiic 

[B3] 0 2^a^<70<7>«ja*cfcy«egw(c^-r0 2 

[04] 0 2:7Py?0<BffMft®mS*£CPU<&a 



[05] B47P- ^^-h<Dlj«PffiJem*itt^^ 

£ IMKDM 0 -e -5 o 

[0 6] B47P- - ^^-H0>lj«i?«3e^fcJ:i;u 

■rittB^0T?&4o 

[0 7] B47P- - ft-h(D$8S^Si:Safii 
(•*) OttlRff«Mt«KlHB7ft«. 

[0 8] @47P- - ^(DmrncDftmrnzTji-tw. 

a^0T?fe^o 

[09] B47P- - ^-V-h(7)I^S^a)if$®S$^-r 
BME0-Cfc£o 
[01 0] 0 8<D*j£<&#&MlCOLNTiS£Lfc> >/< 

[011] H9 0>|»S»a)«««(=oixTttftL/=^> 

£ c 

[0 1 2] 087P- - h(D77^Yl+X/<- 

0-efc^o 

[0 1 3] 0 1 20)7 7 i><< X*X/*— hvXf 

[0 1 4] 0 1 2(D77v<x^-hvXfA"Cfl6 
ffl**i*«Sft«;l«*iJ3£;u— JU»**-rKMH-eft4o 

[01 5] 0 1 20)77 y^I^X/^- h yXf 

[0 1 6] 0 1 2077vVx^7/^hvXfA-C« 

[017] zajrarm*«*BiBii«««&*iM > Bi 

[01 8] c<D«M^m*6*Bttlltt«¥a£<fc< s IJI 
[0 1 9] **a«=**^yS?-f mBSS-rBMIMT? 

fe4 0 

[02 0] «Mi:*477*;-r ttllfcttlkLTca 

B^0t?fc4 o 

[02 1] B47P- T-v-hT?«ISi^ti4j£ffpIte 
SE*L^#*r*-f • ^ -V — KTfe^o 

[02 2] B47P- • KOISfMSftiS 
^t4^^-f> ■ 7P- ■ ft-htfc4o 

[02 3] 04?P- • ha>B«*«*3tft** 

taEE-f 4*-r • ^v— hr*fe4o 

[0 2 4] 0 4?P- • ha>B«*«lc*fr-r*B 

[025] B47P- - ^-v- MDimmm&skiismn 



(8) 



ttm¥-7 - 8 16 0 4 



[02 6] B47P- • ^^r— h(DB««»(D5I*iB»M 

m ]E^m £ taos b v fc & o 

ft) *lf&pco:?a^0-c?fc£ o 
[S28] 027 <D*<r>iniiJt«ii»sa>»ai4^-r^p 

[030] ccD«n(=j:«eiiijefTitff7«flrjt*iattK 

[03 1] |30(DfX h-C*lTRr*B**L^*«6*#a 
[03 2] 0 3O^^0S$j|ftfX h^— *0T?& 



[03 3] 0 3 2<t^«|Cftli3B^*«htWfC^-rittB^ 

0-efc£ o 

1 0 CCDA>7 

1 2 b-^J.-^ h 

1 4 3 — U— h-fcr>-+f 
1 6 

1 8 tMHr>-* 

3 0 IMIcpu 

3 6 HftfFflCPU 

4 2 ls—?mffiCPU 
4 4 ttBtt^CPU 

4 6 «l»i&t**IJ»CPU 

5 o fflttt-HKJ&SfeS cpu 

5 2 ffift9MCPU 

6 0 mmmm ummm#m) cpu 



[01] 






[010] 

mt&z 

ZO PS PM 



PB 




0 10 20 30 40 SO SO 70 80 90 100 |mj 



Min ( 
Min ( 
Min ( 



Min 
Min 
Min 
Min 



Min < 

Min ( 

MHt I 

Mm ( 



Max ( 

Max ( 

Max C 

Max ( 



ale 2 



N 
N 
N 
N 



Z 

z 
z 
z 



I 1 5] 



ten Rule 1 



001 ZO ) 

COIFS ) 

001 PM ) 

031 pb J 



101 TO ) 

0)1 ps ) 

0)1 PM ) 

0)1 PB ) 



COzOl 0)202 ) 

CO PS I - C0PS3 ) 

CO PMI" CO PM4 ) 

COpbi COpbio ) 



Then 
Then 
Then 
Then 

Then 
Then 
Then 




Weight 



OzjOi 

CDZD2 
CO PS I 
CO PMI 

0)203 
CO PS2 

00 PMi 

CO PB2 



Then 
Then 
Then 
Then 



ObjeCOzo 
ObjcCO PS 
ObjeCO PM 
ObjcCO PB 




[0 1 9] 



5 [m] 



70TALotfff?rfifc[frS-~KA 




(9) 



7-81604 



36 



[02] 

32 



CPU 



38 



mmm 

CPU 



30 









44 










/ 


CPU 








CPU 



10 




CCD 

* ^ v 



40 



12 









3.- 7 h 



14. 16, 18 



WW 



3-U- I- 








PWM 




4 


CPU 





3 > 





CPU 



66 




24 



58 



v u y -f k 

n > |«d-7 



7 




(10) t$Ba¥ 7-81 604 



[03] 



3MWJHB\ \*JWMTf»3* 






*\«*«f]5ifr-*(V, y) 

y:3 — u— h 




Fuzzy am 1V 





-J v 



2»Jtt 



(11) 



ftHa 5 ? 7-81604 



[14] 



1 



i 



1 



S10 



S12 



ip*SlJ»JK8fl?C5 



frlSttlli 



c 



S14 



1 



S16 



1 



SI 8 Jtftt^lis. >pi»«8, (ifli*) 
I , S20 



S22 



& VOX iWS WBWfco 
jfgyi Fuzzy gggj 



Fuzzy Expert System^ J: £ 



S24 



Fuzzy Rule 





iJgRuleici £ 







S26 vmk%l Rule 



S28 



S30 



gi^iaS'ii^iSKB^Riifiiiii: 



S32 



1 



Fuzzy Control Systems <t 



Systemic X h 



S34 Funy R u | e 



S36 



(12) 



ttffl¥7- 8 16 0 4 



[05] 



1 11 




zo 




0 10 20 30 40 50 60 70 80 90 100 [m] 



NB 


NM ZOPM 


PB 


m 


( 



-100 -50 

N z 




-100 -30 



50 100 |km/h| 



50 100 Lkm/h| 



[El 7] 



0 1 



0 
0 




0 12 3 



(13) 



7-81604 



[06] 



Y ♦ 



. 2 

- r -> i 



Q'.o 



X 



3/ 4 

,-r 



'0 



! 1 8] 



VFSi-» ln 



I PB| : PM| PBj 

: pb. _psi i _es i 



PMco,, ^ | PM^,/^ 




-A I 


y^j PBa>„ y^j 


--A 






-A I 



PM° =PM, V PM 2 v PMj V -V PM B 
PB> PS * m < LTPB 0 . P5°***!> * 



(14) 



ftBfj^P 7-81604 



[US] 




I25] 

X 



0 




mm 



&lMSHm (l~nvai)[mj 



[@1 3] 



m 1 4] 









mm* 


Mis 


( 


zo 


ZD 


Mln 


( 


ZD 


PS 


Mia 


ZD 


PM 


Min 


( 


ZO 


PB 


Mln 


( 


PS 


ZO 


Mln 


C 


PS 


PS 


Min 


C 


PS 


PM 


Mln 


c 


PS 


PB 


Min 




PM 


ZO 


Min 


\ 


PM 


PS 


Min 


( 


PM 


PM 


Min 


( 


PM 


PB 


Min 




PB 


ZO 


Min 


\ 


PB 


PS 


Min 


( 


PB 


PM 


Min 


c 


PB 


PB 



Max ( 

Max ( 

Max ( 

M»x ( 



OlPSl 
CO PMI 
CO PBl 



C0ZO7 

0>PSS 

CD PM3 



Then 
Then 
Then 
Then 





Weight 


Then 


COzoi 


Then 


(0 202 


Then 


CD zcn 


Then 


C0ZO4 


Then 


C0ZO5 


Then 


CD PS I 


Then 


C0PS2 


Then 


C0PS3 


Then 


C0ZO6 


Then 


C0PS4 


Then 


CO PMI 


Then 


CO PM2 


Then 


(0ZO7 


Then 


(Opss 


Then 


(0 PMJ 


Then 


CO PBl 



UnKOZD 
LincCO PS 
UneCO P* 
LlocCO PB 



TOTALS 5U«wjfllK^ftA 



£fifcl»>c*tf 6 Min Max »t?^&'Jfc 

Min , : , PMn r7* X 



nil if. PM«or/v-yi»3ttS 

PMn 




A. 



«ejlffl»t>ISRiile 1 



Min ( 

Min C 

Min f 

Min ( 

Mm ( 

Min ( 

Min ( 

Min ( 

Min ( 

Min C 

Min ( 

Min ( 

Min ( 

Min ( 

Min ( 

Min ( 

Min ( 

Min ( 

Min ( 

Min C 



Max ( 

Max ( 

Max ( 

Max ( 



ZO 
ZO 

zo 

ZO 
ZO 

PS 
PS 
PS 
PS 
PS 

PM 
PM 
PM 
PM 
PM 

PB 
PB 
PB 
PB 
PB 



NMB 
NMS 
ZOO 
PMS 
PMB 

NMB 
NMS 
ZOO 
PMS 
PMB 

NMB 
NMS 
ZOO 
PMS 
PMB 

NMB 
NMS 
ZOO 
PMS 
PMB 



COzoi- C0ZO2 ) 

COpsi* CO PS3 ) 

CO PMI CO PM4 ) 

COpbi COpbio ) 



Weight 


Then 


COZOI 


Then 


C0ZO2 


Then 


COpsi 


Then 


CO PMI 


Then 


COPBI 


Then 


CDZ03 


Then 


C0PS2 


Then 


CO PM2 


Then 


C0PB2 


Then 


C0PB3 


Then 


C0PS3 


Then 


CO PM3 


Then 


CO PD4 


Then 


C0PD3 


Then 


CO PD6 


Then 


CO PMA 


Then 


CO PB7 


Then 


CDpbb 


Then 


CO PB9 


Then 


COpqio 






Then 


C01 ZO 


Then 


C01 PS 


Then 


COl PM 


Then 


C01 PB 



(15) 



&ffl¥7-8 1604 



[EI9] 



X 




[020] 




7x7x7x7 




A# I 


X 




A:ft2 
A* 3 


PB.IWS.ZO.NS.NM^NB 

X 

ra,PM.PS.ZO.NS,NM.NB 


2401 


A#4 


X 

FB.PM,PS,ZO.N5,NM.NB 





#BHB» 7x7+7x7+4x4 

A?) 1 PB.PMJS.ZO^SJfMOT ^ 



ZO,PS,PM,PB 



KTi 2 PBJ'M.PS.ZO.NS.NM.NB x .114 

KTi 3 FB,PM,PS^O,NS,NM,NB 



A^J 4 PB r PM,PS,ZO,NS.MM,NB 49) 



^ ZO.PS,PM,PB ° 6) 



(17) 



ffi¥7-8 16 04 



12 6] 



ObjeCO zo 
ObjeCO PS 
ObjeCO PM 
ObjeCO pb 
ObjeCO ZO 
ObjeO) PS 
ObjeCO PM 
ObjeCO PB 
ObjeOOZO 
ObjeCO PS 
ObjeCO pm 
ObjeCO PB 
ObjeCt) ZO 
ObjeO) PS 
ObjeCt} PM 
ObjeCO pb 



Weight 



Min 


( LhxCOzO 


Min 


( UnctOzO 


Min 


[ UneCOzo 


Min 


[ LineCOZO 


Min 


( LtoeCOPS 


Min 


[ Lined) PS 


Min 


( LineO)PS 


Min 


( UocCOPS 


Min 


( UneCD PM 


Min 


( liiwCO PM 


Min 


( Li*C0 PM 


Min 


( LineOJPM 


Min 


( Line CO PB 


Min 


( LbteCO PB 


Min 


( LtoQ) PB 


Min 


( UneOOPB 



) Then 


CO ZOi 


) Then 


0>ZQ2 


) Then 


C0ZO3 


> Then 


C0zO4 


> Then 


C0ZOS 


> Then 


COP&i 


) Then 


C0PS2 


) Then 


CO PS3 


) Then 


C0ZD6 


) Then 


CO PS* 


) Then 


CO PM1 


) Then 


COpbi 


) Then 


CO ZD? 


) Then 


COpss 


) Then 


CO PM2 


) Then 





Mu ( CO ZOI • 

Max ( COpsi 

Max ( CO pmi 

Max < COPBI 



C0ZO7 

C0PS3 

C0PM2 



Then 
Then 
Then 
Then 



TotalCO ZO 
Total CO ps 
TouslW PW 
Total CO PB 



TOTAL© jS?TTfiStfr&^3l* 

TOTAL WEKJHT =C (TotalCO ZOJP.OfU (TotalCO PS) 2 .0i5+(TotolCD PM) 2 ,06A+ 
CTolalCO PB^O.W] / (TotalCO ZO+TotalCO Ps* Tot a ICO PM + ToulCO PB) 




X 



coj(fl2-81) -sin(02-61) 
tiiX62^ei) cos(92-ei) 



x2xl 



12 1] 








PID 



[028] 





* 
fa 


~> 





^¥7-8 1 60 4 



[0 17] 







< 








» 








m 




1 




















a 
w 












ecu" 




< 








3 




















a 






1 






* 


** 








-v 




H 








* 
Eg 




-R 


H 


33 


*• 

e 


6 












« 






Si 










I 


1 





— oJ m 

N M N 

CQ CQ 03 




IS- 
lC 



SI 



™ « n ,„ c 

m si pa aT cf 



g s s 



N M N 
■JJ N 



3 *a 

< <r < < <- 

£ .9 -89 C/3 W 



? ? "g -d 1 

CM 5n — £ 
.2 .2 .$2 u, .13 



!t3 I* ?tt 

— * cm tn 

ef £ pT 

* * * 
i I I 

* * * 



— e 

I i 

5* 




c 



III 



CM CM CN 

41 Si i* 

P< K PK 



CM 

OQ 

< 

3 



< < 



cm 



c 



3 

as 



CM 

pa 

< 

I 5 



CM 

so 



i 



s 



cm 

< 
c 

CM 

3 



C^B, ci>Jl C>JI ti>jT C>J 



1 



3 



3 









1 


1 




cn 




3" 




i* 




P< 




cn 









— i CM 

00 PQ OQ 03 5 

<u <u< u<J- < B 

S S ^ >C S 

Its its its 



CM CM N CM 2 

T* rr 1 . T* 



CM 

1 



I 



! 



0* 

i 



CM 




(19) 




(20) 



^¥7-8 16 0 4 



[023] 




Sffflt 



I24] 



I29] 



% 



o 

«} 

□ 






0 10 20 30 40 50 60 70 80 90 100 [m] 




100 rkm/h) 



0 10 20 30 40 50 60 70 80 90 100 [km/h] 



13 1] 



1 -r 




230 [m] 



(21) 



^§§¥7-8 16 0 4 



[03 0] 

f|J«SJ*[lan/h] 



lOOfm] 



250 lm] 



[@3 2] 



iOOfrpfc] 




100 



i i i i t i i i i i » i i i i i 

150 200 250 {m} 



JOOCm] 



50 



13 3] 



I 1 I > I 1 I I I 1 I I I I I I I t 1 I 1 I I I I : 1 I 



50 100 



150 



200 



250 [raj 



(51) Int. CI. 6 

G08G 1/16 
// GO 5 B 13/02 



B 6 2 D 101 
113 
137 



00 
00 
00 



C 7531 -3 H 
N 9131-3H 



F I 



This Page is Inserted by IFW Indexing and Scanning 
Operations and is not part of the Official Record 

BEST AVAILABLE IMAGES 

Defective images within this document are accurate representations of the original 
documents submitted by the applicant. 

Defects in the images include but are not limited to the items checked: 

□ BLACK BORDERS 

□ IMAGE CUT OFF AT TOP, BOTTOM OR SIDES 

□ FADED TEXT OR DRAWING 

J0f BLURRED OR ILLEGIBLE TEXT OR DRAWING 

□ SKEWED/SLANTED IMAGES 

□ COLOR OR BLACK AND WHITE PHOTOGRAPHS 

□ GRAY SCALE DOCUMENTS 

□ LINES OR MARKS ON ORIGINAL DOCUMENT 
^QTrEFERENCE(S) OR EXHIBIT(S) SUBMITTED ARE POOR QUALITY 

□ OTHER: 

IMAGES ARE BEST AVAILABLE COPY. 
As rescanning these documents will not correct the image 
problems checked, please do not report these problems to 
the IFW Image Problem Mailbox. 



